#ifndef __SU_MOTOR_H__
#define __SU_MOTOR_H__

#define Speed_P	100L
#define Speed_I	7
#define Speed_D	20

extern int RealSpeed1;
extern int RealSpeed2;
extern long OutputCtrl1, OutputCtrl2;

void MotorInit(void);
void MotorCtrl(int Motor1_duty, int Motor2_duty);
void MotorCtrl_WhitPID(int TargetSpeed1, int TargetSpeed2);

#endif